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Die folgenden Angaben sind den vom Anmelder eingereichten Unterlagen entnommen 

@) Verfahren und Vorrichtung zur Dejustageerkennung bei einem Kraftfahrzeug-Radarsystem 

(57) Verfahren und Vorrichtung zur Dejustageerkenung bei 
einem Kraftfahrzeug-Radarsystem, bei dem elektroma- 
gnetische Wellen ausgesendet werden, bei dem von ei- 
nem stehenden Objekt reflektierte elektromagnetische 
Wellen empfangen werden und bei dem anhand der aus- 
gesendeten und der empfangenen Signale ein relativer 
Winkel (a m ) und ein relativer Abstand (d m ) zwischen dem 
detektierten Objekt und einer Bezugsachse des Kraftfahr- 
zeugs sowie eine Relativgeschwindigkeit ^ m gwischen 
dem detektierten Objekt und dem Kraftfahrzeug bestimmt 
werden, wobei anhand des relativen Winkels (0^), des re- 
lativen Abstands (d m ) und einer Fahrzeug-Eigenge- 
schwindigkeit (v F ) ein Korrekturwert (ocq) fur den relativen 
Winkel (o^) bestimmt wird. 
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Beschreibung f 

Die vorliegende Erfindung betrifft ein Verfahren und Vorrichtung zur Dejustageerkennung bei einem Kraftfahrzeug- 
Radarsystem nach dem Oberbegriff des Hauptanspruchs und des nebengeordneten Anspruchs. Ein solches Verfahren und 
5 eine solche Vorrichtung werden beispielsweise im Rahirien einer automatischen Geschwindigkeitsregelung eines Fahr- 
zeugs zur Detektion vorausfahrender Fahrzeuge eingesetzt. Ein gattungsgemaBes System wird auch als Adaptive Cruise 
Control (ACC) bezeichnet. Beim Einbau des Kraftfarzeug-Radarsy stems in das Kraftfahrzeug ist eine prazise \forge- 
hensweise und eine exakte Ausrichtung einer Zentralachse der abgestrahlten elektromagnetischen Wellen auf eine zen- 
tralen Linie des Kraftfahrzeugs in Langsrichtung erforderlich. 

10 

Stand der Technik 

Die US 5,930,739 offenbart ein Verfahren zur Messung der Drehrate eine Kraftfahrzeuges, das mit einem T JDAR-Ra- 
dar ausgestattel ist. Bei diesem Verfahren wird die von einem Drehratensensor ermittelte Drehrate anhand der eigenen 

15 Fahrzeuggeschwindigkeit, einer longitudinalen Entfemung zu einem festen Detektionsobjekt und der relativen Querge- 
schwindigkeit des selben festen Detektionsobjektes in Bezug auf das eigene Fahrzeug bestimmt Der Nachteil dieses 
Verfahrens ist darin zu sehen, daB zur genauen Bestimmung bzw. Korrektur der Drehrate kieine Offsets und weit ent- 
fernte Detektionsobjekte erforderlich sind. Insbesondere weit entfernte Objekte sind bei Radar-Anwendungen jedoch 
"schwache Ziele", die schwer zu messen sind und deren Position in Querrichtung zum eigenen Kraftfahrzeug wegen der 

20 begrenzten Winkelauflosung des Radar-Systems nicht immer exakt erfaBbar ist. Aus dem selben Grund (bebrenzte Win- 
kelauflosung) ist auch die Bestimmung von Quergeschwindigkeiten detektierter Objekte, insbesondere in groBeren Ent- 
femungen, fehlerbehaftet. 

DieDE 197 36 965 CI offenbart ein Verfahren und eine Anordnung zur Uberprufung der Gierrate eines sich bewegen- 
den Objekles, insbesondere eines Kraftfahrzeuges. Hierbei wird die Gierrate mit Hilfe von Objekten uberpruft, die sich 

25 im aktuellen Umfeld des Kraftfahrzeuges befinden. \foraussetzung ist, daB es sich bei den von einem Umfeldsensor er- 
faBten Objekten um festslehende Objekte handelt. In diesem Fall wird die aktuelle Position des deieklienen Objekts mil 
einer aus der crslmaligcn Erfassung des detektierten Objekts abgclcitctcn Projcktion auf die aktuelle Position vcrglichcn. 
Hierzu wird eine Objektspur bestimmt, die alle Positionen des detektierten Objekts zu unterschiedlichen vorgegebenen 
Zeitpunkten enthall. Die Objektspur wird dabei ausgehend von der erfaBten Position des detektierten Objekts mit Hilfe 

30 der Geschwindigkeit und der Gierrate des Kraftfahrzeugs gebildet. Der Nachteil des Verfahrens liegt darin, daB eine Zer- 
legung der bestimmten Radialentfernung des detektierten Objekts zum eigenen Kraftfahrzeug in x- und y-Positionskoor- 
dinaten erforderlich ist. In eine solche Zerlegung geht in der Regel der Winkel des detektierten Objekts ein, der bei einem 
auf Laser- oder Radar basis arbeitenden System nicht besonders exakt bestimmbar ist, da von einer begrenzten Winkel- 
auflosung ausgegangen werden muB. 

35 Die DE 197 5 1 004 A 1 olTenbart ein Verfahren zur Verarbeitung von Radarsignalen, bei dem durch Auswertung einer 
Mehrzahl von zu erfaBten Objekten gebildeten Objektspuren eine aktuelle Bewegungsrichtung erniiuelt wird. Bei einer 
Abweichung dicscr Bewegungsrichtung von der Ausrichtung der Radar anordnung werden die bei der Erfassung der Ob- 
jekte im Rahmen der Winkelauflosung der Radaranordnung ermittelten Objektwinkel durch die bestimmte Abweichung 
korrigiert und auf die Bewegungsrichtung bezogen. Das Verfahren bezieht sich auf eine Trajektorienanalyse der detek- 

40 tierten Objekte, wobei insbesondere die Reflexionen von feststehenden Objekten verwendet werden, da diese eine beson- 
ders giinstige Grundlage fur die Ermittlung der mittleren Bewegungsrichtung bilden. 

Aus der DE 198 33 065 Al ist eine Winkelverschiebungsbestimmungsvorrichtung zumErfassen der Winkelverschie- 
bung der Radarzcnlralachse zur Verwendung in einem Erf ass ungssy stem fur ein Kraftfahrzeug bekannt. Bei dieser Vbr- 
richtung werden bei der Erfassung der Positionen der Ziele zwei Situationen unterschieden. Der erste Fall ist der; daB 

45 vorausfahrende Fahrzeuge erfaBt werden, wahrend sich das eigene Kraftfahrzeug in einer Geradeausfahrt befindet. Hier- 
bei sollte sich bei einem korrckt eingestellten Erf assungssy stem eine Verteilung der detektierten Positionen der voraus- 
fahrenden Fahrzeuge ergeben, die parallel zur eigenen Fahrtrichtung Uegt. 1st dies nicht der Fall, so wird eine Schwer- 
punktbildung durchgefuhrt, eine cntsprechende Ausgleichsgerade ermittelt und das Erfassungs system entsprechend kor- 
rigiert. Der zweite Fall isi der, daB sich das eigene Fahrzeug in einer Kurvenfahrt befindet. In diesem Fall wird eine Ana- 

50 lyse der Relaiivgeschwindigkeitsvektoren zwischen dem eigenen Fahrzeug und den detektierten Objekten durchgefuhrt. 
Nachteil dieses Verfahrens ist, daB zur eine Analyse der Relativgeschwindigkeitsvektoren die x- und y-Komponenten 
des Relativgeschwindigkeitsvektors erforderlich sind, die wie bereits angefiihrt nicht besonders exakt bestimmt werden 
konnen 

55 Vorteile der Erfindung 

Das erfindung sgemaBe Verfahren ist gegenuber dem Stand der Technik dadurch weitergebildet, du° ^ei einem Verfah- 
ren zur Dejustageerkennung bei einem Kraftfahrzeug-Radarsystem, bei dem elektromagnetische 'len ausgesendet 
werden, bei dem von einem stehenden Objekt refiektierte elektromagnetische Wellen empfangen wer den und bei dem an- 

60 hand der ausgesendeten und der empfangenen Signal e ein relat.iver Winkel (cO und ein relativer Abstand (d m ) zwischen 
dem detektierten Objekt und einer Bezugsachse des Kraftfahrzeugs so wie eine Relativgeschwindigkeit (d m ) zwischen 
dem detektierten Objekt und dem Kraftfahrzeug bestimmt werden, anhand des relativen Winkels (On,), des relativen Ab- 
stands (d m ) und einer Fahrzeug-Eigengeschwindigkeit (vp) ein Korrekturwert (oto) fiir den relativen Winkel (otm) be- 
stimmt wird. Dieses erfindungsgemaBe Verfahren hat den Vorteil, daB aus den ohnehin bei einem Kraftfahrzeug-Radar- 

65 system vorliegenden MeBwerten ein Korrekturwert fur das System selbst bestimmt werden kann. Auf diese Weise ist 
eine schnelle und zuverlassige Korrektur des WnkehneBwerts des Kraftfahrzeug-Radarsystems moglich. 

Eine Vorteilhafte Weiterbildung des erfindungsgemaBen Verfahrens sieht vor, daB anhand des relativen Winkels (a,,,), 
des Korrekturwert s (fXo), des relativen Abstands (d m ), der Relativgeschwindigkeit (d ra ), der Fahrzeug-Eigengeschwin- 
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digkeit (v F ) und einer von einem Drehratensensor gelieferten Drehrate (\j/ m ) ein Korrekturwert (\j/ 0 )fur die Drehrate 
(\|/ ra ) bestiinmt wird. Mit anderen Worten: Mit Hilfe der von dem Kraftfahrzeug-Radarsystem gelieferten MeBwerte 
kann der von einem beliebigen Drehratensensor (Gierratensensor) gelieferte DrehratenrneBwert korrigiert werden. Auf 
diese Weise ist eine zuverlassige und schnelle Bestimrnung der Drehrate (Gierrate) des Kraftfahrzeugs moglich. 

Bei einer besonders vorteilhaften Weiterbildung des erfindungsgemaBen Verfahrens wird anhand des relativen Win- 5 
kels (a,*), des Korrekturwerts (Oo), des relativen Abstands (d ra ), der Relativgeschwindigkeit (d m ) und der Fahrzeug-Ei- 
gengeschwindigkeit (v F ) eine Drehrate des Kraftfahrzeugs bestimmt. Durch dieses erfindungsgemaBe Verfahren ist 
es moglich unter Zuhilfenahme der von einem Kraftfahrzeug-Radarsystem gelieferten Daten, die Drehrate (Gierrate) des 
Kraftfahrzeugs zuverlassig und schnell zu bestimmen; ohne daB ein konventioneller Drehratensensor in dem Kraftfahr- 
zeug vorhanden sein muB. 10 

Der groBe Vorteil des erfindungsgemaBen Verfahrens und der erfindungsgemaBen Vorrichrung liegt darin, daB die Off- 
set-Bestimmung von Winkelmesswert und Drehratenmesswert sowie die Drehratenbestimniung wahrend des Betriebes 
des Fahrzeugs "online" erfolgen kann. Damit kann auch wahrend des Betriebs des Kraftfahrzeugs ein sich verstellender 
Offset des Winkelmesswertes und des Drehrat entries swertes permanent korrekt kompensiert werden. Eine separate Ver- 
messung der Sensoren, zum Beispiel in einer Werkstatt, ist nicht erforderlich. Hierbei beruht das erfindungsgemaBe \er- is 
fahren nicht auf einer Mittelwertbiidung der von dem Kraftfahrzeug-Radarsystem erfaBten Daten von stehenden Objek- 
ten, sondern auf einer Berechnung, die die von den stehenden Objekten erfaBten Daten als Grundlage hat. Ein weiterer 
enischeidender Vorteil ist, daB die Berechnung in jeder beliebigen Fahrsituation erfolgen kann, unabhangig davon, ob 
sich das Kraftfahrzeug in einer gerade Linie fortbewegt, oder ob sich das Kraftfahrzeug in einer Kurvenfahrt. befindet. 



Beschreibung von Ausfuhrungsbeispielen 



l^wo(0 - x liW * e l w + x 2 ,w * e 2,w 

Aus Sicht des Kraftfahrzeuges 22 ergibt sich die Position des stehenden Objekts 21 aus einer Summe von skalaren 
Vielfachen der Einheitsvektoren des Fahrzeugkoordinatensystems 23, 24: 

R Fo(0 = x i t p • e i t F + X2,F • e 9,F 

Wird der Vektor, der die Position des Fahrzeugs aus Sicht der festen Welt beschreibt mit Rwr(t) bezeichnet, so kann 
die Position des Objekts 22 auch wie folgt beschrieben werden: 

Rwo(0 = RwfO) + Rfo(0 = RwKO + x ltF ■ e ltF + x 2)F * e 2 , F 
wobei: 



20 



Im folgenden werden Ausfuhrungsbeispiele des erfindungsgemaBen Verfahrens und der erfindungsgemaBen Vorrich- 
tung zur Dejustageerkennung bei einem Kraftfahrzeug-Radarsystem anhand von Zeichnungen erlautert. 

Es zeigen: 25 
Fig. 1 zeigt ein Kraftfahrzeug, das ein sLehendes Objekt deteklierl, 

Fig. 2 zcigt cine Darstcllung der Koordinatcnsystcmc, die fur die Bestimrnung der Dejustagc bcriicksichtigt werden 
miissen, 

Fig. 3 ein Ablaufdiagramm des erfindungsgemaBen Verfahrens und 

Fig. 4 eine Darstellung einer erfindungsgemaBen Vorrichtung. 30 

Fig. 1 zeigt ein Kraftfahrzeug 10, das mit einem erfindungsgemaBen Kraftfahrzeug-Radarsystem 11 ausgestattet ist, 
das in diesem Ausfuhrungsbeispiel in Fahrtrichtung in der Mi tie des Kraftfahrzeuges 10 montiert ist. Mit 12 ist die Fahr- 
zeuglangsachse des Kraftfahrzeugs bezeichnet, auf die idealerweise auch die Strahlrichtung des Radarsystems 11 ausge- 
richtet sein sollte. Mit 13 ist ein von dem Radarsystem 11 detektiertes mogliches stehendes Objekt, beispielsweise eine 
Bake am StraBenrand oder ein Baum, bezeichnet. Die Entfemung zum detektierten Objekt 13 ist mit 14 und der Winkel 35 
der detektierten Position bezogen auf die Fahrzeuglangsachse 12 ist mit 15 gekennzeichnet. ErfindungsgemaB wird eine 
mogliche Dejustage des Radarsystems 11 anhand der von dem stehenden Objekt 13 gelieferten MeBdaten unter Zuhil- 
fenahme der Fahrzeugeigengeschwindigkeit bestimmt. Hierzu ist im Extremfall lediglich eine detektierte Position des 
stehenden Ziels 13 erforderlich. Wird ein und das selbe Ziel in mehreren Detektionsschritten erfaBt so konnen die berech- 
neten bzw. bestimmten Korrekturwerte fur das Radarsystem entsprechend gefiltert werden. Wird mehr als ein stehendes 40 
Objekt detektiert, was in der Praxis eher der Regelfall ist, so konnen die bestimmten Korrekturwerte fur das Radarsystem 
uber mehrere Objekte gemittelt werden. Im AnschluB an die Bestimrnung eines Korrekturwertes fur die Winkelmessung 
des Radarsystems kann erfindungsgemaB die Drehrate des Kraftfalirzeugs entweder bestimmt oder unter Zuhilfenalime 
eines von einem Drehratensensor gelieferten Signals korrigiert werden. Andere statistische Nachbehandlungen liegen 
ebenfalls im Ralimen des erfindungsgemaBen Verfahrens. Hierbei kann die Art und Weise der Nachbehandlung auch da- 45 
von abhangig gernacht werden, wieviel Zeit fur die Auswertung beziehungs weise fur die Bestimmung der Korrektur- 
werte und/oder der Drehrate zur Verfugung steht. 

Fig. 2 zeigt eine Darstellung der Koordinatensysteme, die fur die Bestimmung der Dejustage beriicksichtigt werden 
miissen. Hierbei ist ein weltfester Punkt, sozusagen der Ursprung des "Weltkoordinatensystems" mil 20 bezeichnet. Mit 
22 ist die gegenwartige Position des Kraftfahrzeuges bezeichnet und mil 21 ist die mogliche Position eines detektierten 50 
stehenden Objekts bezeichnet. 23 und 24 sollen die Einheitsvektoren des Weltkoordinatensystenis darstellen und 27 und 
28 die Einheitsvektoren des Fahrzeugkoordinatensystems. 

Der Vektor, der die Position des stehenden Objekts 21 im Weltkoordinatensystem beschreibt ergibt sich aus einer 
Summe von skalaren Vielfachen der Einheitsvektoren des Weltkoordinatensy stems 23, 24: 



55 



60 
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Rwo(0 = Vektor von der festen Welt zum Objekt 25 

c l,w, C2,w = Einheitsvekioren des Weltkoordinatensystems 23, 24 

Xi t w» X2 T \v = Skalare Faktoren im Weltkoordinatensysiem 

R FO (t) = Vektor vom Fahrzeug zum Objekt 29 
5 cip, e^2,F = Einheitsvekioren Fahrzeugkoordinatensyst. 27, 28 

Xi,b X2,f = Skalare Faktoren im Fahrzeugkoordin at en system 

R-wfW - Vektor von der festen Welt zum Fahrzeug 26 

Ausgehend von diesen Festlegungen kann man durch Einsetzen der aus Fig, 1 ersichtlichen Beziehungen Bestim- 

mungsgleichungen fiir die Offsets von Winkel und Drehrate bestimmen, die unter der Vorraussetzung von kleinen Win- 
10 keloffsets vereinfacht werden konnen. Damit ergeben sich erfindungsgemaG die Offsets fiir den Winkel und die Drehrate 

nach den folgenden Beziehungen: 



is ° sin(a m ) sin(a m ) v F 



20 



35 



40 



Vo*Y m - Vp . ■ [j| {d m ■ sin(or ro )) - a 0 ~ {d m ■ cos(a m ))J 



wobei: 

ocq = Winkeloffset des Umgebungssensors 
a ra = nicht. Offset- korrigierter WinkelmeBwert 
25 d m = gemessener Abstand 

d ra = gemessene Relalivgeschwindigkeit 
v h = Fahrzcug-Eigcngcschwindigkcit 
\j/ 0 = Drehraten-Offset 

>j/ m = nicht Offset-korrigierter DrehratenmeBwert 
30 Sollen die absoluten, Offset- freien Werte fiir den Winkel und die Drehrate angegeben werden so ergibt sich erfin- 
dungsgemaG: 

a = oCm-ao und \\f = y m -\j/o daraus folgt: 

cos(a; m ) 1 d m 
a» a m + — + -. — r - — =- 

sm{aj sm{a m ) v F 



if/ f» 



V F 



d -d 



^{d m ■sm{a m ))-a (s -j { {d m -cos(a m )) 



wobei: 

45 a = ermittelter Offset- freier Wert fiir den Winkel 
x\f — ermittelter Offset-freier Wert fur die Drehrate 

Hier ist in besonders vorteilhafter Weise in der Bestimmungsgleichung fur die Drehrate keine Abhangigkeit von einer 
gemessenen Drehrate mehr vorhanden. Es konnte somit bei Ausfall oder Defekt des Drehraten sensors ein Ersatzwert be- 
stimmt werden oder es kann der bestimmte Drehratenwert zu einer Plausibilitatsuberprufung des gemessenen Drehraten- 

50 wertes verwendet werden. 

Fig. 3 zeigt ein Ablaufdiagramm des erfindungsgemaBen Verfahrens. In Block 31 beginnt die Inbetriebnahme des 
Kraft fahrzeuges bzw. die Inbetriebnahme des Kraftfahrzeug-Radarsystems. In Schritt 32 werden die von dem Radarsy- 
stem ermittelten Winkel-, Abstands- und Relativgeschwindigkeitswerte eines stehenden Objekts ennittelt. In Schritt 33 
wird die Fahrzeugeigengeschwindigkeit gemessen oder von einem Bussystem oder einem Kombi instrument ubernom- 

55 men. Je nachdem, ob der Drehratenwert ohne den gemessenen Drehratenwert beslimmt werden soli, oder ob ein Korrek- 
turwert fur den gemessenen Drehratenwert bestimmt werden soil, wird in Schritt 34 der gemessene Drehratenwert erfaBt. 
In Schritt 35 erfolgt die erfindungsgemaBe Bestimmung der Korrekturwerte fur den Winkelfehler des Radarsy stems und 
enrweder die Bestimmung des Korrekturwertes fur die Drehrate oder die Drehrate selbst. Diese Daten werden in Schritt 
36 in einen Speicher eingelesen und dort entsprechend den Erlauterungen zu Fig. 1 gefiliert und/oder gemittelt. In Schritt 

60 37 werden die endguUigen bestimmten Korrekturwerte fiir den Winkelfehler des Radarsy stems und entweder die Bestim- 
mung des Korrekturwertes fur die Drehrate oder die Drehrate selbst ausgegeben. 

Fig. 4 zeigt eine Darstellung einer erfindungsgemaBen Vorrichtung. Mit 41 ist ein Radarsensor bezeichnet, der seine 
MeBdaten an ein Steuergerat 42 ubermittelt. In dem Steuergerat 42 ist weiterhin eine Speicher-, Filter- und Mittelungs- 
einheit 43 integrierL, die die in den Beschreibungen zu den Fig. 1 und 3 erwahnten Funktionen ubernehmen kann. Ein im 

65 Kraftfahrzeug vorhandenen Sensor fur die eigene Geschwindigkeit ist mit 44 bezeichnet und ein Drehraten sensor mit 45. 
Mit 46 ist ein im Fahrzeug gegebenenfalls vorhandenes Bussystem, beispielsweise ein CAN-Bus bezeichnet. 

Der groBe Vorteil des erfindungsgemaBen Verfahrens besteht darin, daB MeBdaten stehender Objekte unter Benutzung 
der angegebenen Beziehungen zur Bestimmung von Winkeloffset, Drehratenoffset und Drehrate selbst zu benutzen. 



4 



3NSDOCID: <DE 



19964020A1_I_> 



DE 199 64 020 A 1 



Patentanspruche 

1. Verfahren zur Dejustageerkennung bei einem Kxaftfahrzeug-Radarsystem, bei dern elektromagnetische Wellen 
ausgesendet werden, bei dem von einem stehenden Objekt reflektierte elektromagnetische Wellen empfangen wer- 
den und bei dem anhand der ausgesendeten und der empfangenen Signale ein relati ver Winkel (0^) und ein relativer 
Abstand (d m ) zwischen dem detektierten Objekt und einer Bezugsachse des Kraft fahrzeugs sowie eine Relativge- 
schwindigkeit (d m ) zwischen dem detektierten Objekt und dem Kraftfahrzeug bestimmt werden, dadurch gekenn- 
zeichnet, daB anhand des relati ven Winkels (ctm) des relati ven Abstands (d m ) und einer Fahrzeug-Eigengeschwin- 
digkeit (v F ) ein Korrekturwert (Oq) fur den relativen Winkel (o^) bestimmt wird. 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, daB anhand des relativen Winkels (a m ), des Korrektur- 
werts (oto), des relativen Abstands (d m ), der Relativgeschwindigkeit (d m ), der Fahrzeug-Eigengeschwindigkeit (v F ) 
und einer von einem Drehratensensor gelieferten Drehrate (y m ) ein Korrekturwert (\j/ 0 ) fur die Drehrate "(\j/ m ) be- 
stimmt wird. 

3. Verfahren nach Anspruch 1, dadurch gekennzeichnet, daB anhand des relativen Winkels (a m ), des Korrektur- 
werts (ao), des relativen Abstands (d m ), der Relativgeschwindigkeit (dm) und der Fahrzeug-Eigengeschwindigkeit 
(vp) eine Drehrate des Kraftfahrzeugs bestimmt wird. 

4. Verfahren nach Anspruch 1, dadurch gekennzeichnet, daB Verfahren unabhangig von der gegenwartigen Fahrsi- 
tuation des Kraftfahrzeugs, insbesondere unabhangig von einer Kurvenfahrt, durchgefuhrt wird. 

5. Vorrichtung zur Durchfuhrung des Verfahrens zur Dejustageerkennung bei einem Kraftfahrzeug-Radarsystem 
nach Anspruch 1. 
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